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im#mi) miEowmom&fo^Wif&zh. i^>© 

S£ t £gWTftWr-t-fco2r3©g|#££2K HtjlBl^J 
©«jSttttt«iH£©« !K B5I3 2 o©»#tt« 

[flt$«2] HiJi3BfS©li«rtfcfilW^ 
ft 4 »#»* 1*E«© 3 ftTcffiHSKIMSffl * o 
[BUM! 3] tiiE&&<£. ffiESfS©«««-fc»tt3 

n ft n»saf i ®ffi«© 3 ^^fig^^iJ^ffl v - * „ 

[§S*S4] iiyf3££l±, h5I32o©^ StfrniSB 
2 0©&#fc£toft'J>fc< ti) 2 0ffl^aj5"r >tC«t-3 

-t a t ft 5 pSM©^iPJi £ $ ft 5 m&mm 2 1113s© 

[§f 5jcJl 5 ] h5§3£jS«U buI32o©^, StfifisB 
2 o©$£# i: £fr 5 'J>fc < i: t 2 -3©tftaj 7 -< > £ £ c 
T H * ft 4 St$©> £ II ft * ft 5 M *** 2 IB«© 
3&7t(2ggf&»i£fflv-? 0 

«IS»»«I©«tlCJBi;TjEttt*v-^ 

% 2 ©¥®£'i»S: < 2 o© 1 *5c^-b >y*UW. 
U 

Iul3^- # £ ft ft wiM 2 o ffl£g#©&l#^ £ hu §3^ 
2 ffl¥EC 2 ^IfilicffM LTiJl3'i»&: < 1 1> 2 o© 1 & 

jcTfe -t > tf- c n $ # [Si © & t %?tm •*§• 

fuI3§7 l c<I?{ca^V>Tali!3 2 -3©&#&©iiiji3'J>& < 
i: t, 2 -o© 1 *7c^-b >U-±©{iS£3m U 
hu83'>& < t * 2 o© 1 »7c)t-fe >-9-±©{iHta6^^ 
T«B^-*£S*ft*2-3©l*#CJ:oT*tK*ft* 
mjl3^©fiSi:, iiffiv-^ £^$ftftifli§3 2-3fflfll 
a©S»ft**t ft - i: ZftWlttZ 3 ^TcteSS^J 

[§»*S7] H3E^-fBu BuEffl^ftft©**^ 
ftiBB 2 o©«#©'J>& < i: t» 1 ool^ t UT £S L 

[W«JS8] SuE^-fti* H5E2oofi#©'J>fc< 

H£#fc»£ »l* fr? Iff 6 «E«© 

[11*119] S5E^-*ttx fSEMS»ft»i:SW* 
tfS&Stf»S^ &£^&&SUTijE2o 

rgSB 6 SE«o 3 &7c{Mj6»M£*iS. 

1 0 ] fiSE^-^tt, S9E«£#ft*&#» 



■2') ^ &gfi¥9- 1 1 3 2 2 4 

2 

[If aRJS 1 1 ] h5E'>& <tt>2~3V>l *7G#-t: >1f 
U 

miE^-*t^**i*ME2o©S»©«»fifcSH9E* 

[M$a 1 2 ] mnttm\c$>h% 1 ©^aicjf^^ 

ft, lo©£££g{Jtt£¥fTT-^2o©&|#£$ 
!WJ3»S«ft ! l*l©«ttCJ6tTaffit*^-i'fc. 

10 ^2©¥®(cgilBv-^!C-g^ftSBiiI32o©^©^ 

bu13^ 2 ffl^StcSSa^ft, ml3 2 ^©^©$i«-^ic 

< i:* 2o© 1 *7cJfe-b>-9-i:, 
HulBSi'Gfl^tcSooT h5I3 2 o©^^©iil3'>* < 

tfe2o©i &7c3fc-t: >if±©{assiiisc-r i ©<« 

T SUH3-7 - 9 C * * ft -5 2 ooll^t <t o T ttft * ft ft 
20 mIl35^.#.ffl^4§i:^ Hljl3-7-^i-^*ftftBll!32o©^ 
^•©S^^ilSt ftg 2 ©il»#SS:^(i-r ft 3 1 S:^ 

ft 3 ^7c{£KS»iM£SB. 
[«5)<Ja 1 3 ] B?il3^-^tt, h5I3 2 -3©tt#©'J>fc 

< i: i ^ou^mim^nmiOix. ? v c £ o 

BE^ftftilARJM^ 1 2JSS3«© 3*5£(4M«^i9i^^ 

So 

[11^1114] mifB^-^li, fu!3 2offiS!|#ffl4>& 

< h-fe l^o^tfiiieai^^tiffMSftfe^aia 

fflffl§BPC£oTSfi£$ftftli*il* 1 2ijiI311©3ft 
30 TcffiBSIIffl^SK. 

[IlStcfl 1 5 ] 1513^-^ J±, s5I3 2 o©^©^^ 

< i:*, 1 ^©^^HljlBil^^tCHylBjfJ^M^i: 
Ktf5pAMI&ft#*4£^ ftS^ $>ft^«S1"ft^ 
i: C £ o T «5g S ft ft ai^Ji^ 1 2 III3K© 3 Jk-JcfflB 

1 6 ] ft Wi#»iitt©ttt*C J: 

oT^E£?ft> Huf3v-^li, alE2^©«d©iPa< 

40 fc*r«;:fcC±-3T*«£iiftJ*#B!8l 2E83H© 

1 7 ] ffigBflMBA^att, hu§3 2 o©^^© 
«WMfc**3, *4©¥lC-tix*iUBl«-rft«l«S1f 

b> 

Hu!3li>^<i:^2o©l*7c^-fe>tHi, ^3, ^4© 
iFHt^n j eix*a<i:*.2-3EB*ix*fll***tft 
IS*SW 1 2il!3m© 3 ft7c<&B£ftfl!£SI. 

[0 0 0 1] 

so [«w©Hraftfs»s] **wtt3jk7ctt«ss»ais 
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[0 0 0 2] 

fkbTSJkTcCDfflBStfftf&OWWfeSStb. -^3* 
7c©ffiBSif*»*3WKt:aSUfcffiffl*t«ftUx t 

[0003] c©j:afe3«5c©fflttstJ c s»saa^i" 

*©ffe£fe*SBB¥3- 1 3 5 7 1 8^fi«tc{±2 
#©¥tT fciSttfe*? 1 U^ffitC <fc otlft 3 *7g£ 

[0 0 0 4] L^U C©3ifc5E{aBg»ffl££Bfc:<fc 
Si:, ^n;*^7lf0aflfe^®«CttCCD©2ft7C-*r 

l/3 0#Sf:(il/6 0#T-fei)o ^tlit 

U — ^ © ^E— ^S»J»a$fio 7 - K A y ^ ©It -f 

-f A#-ffitC 1/1 0 0 0«?ttT-e*5©tJt^T#S 

lIiffl©IifK* s 5 0 0 x 5 0 0SST-$>5fc», #8?f£ 

[0005] »«»««s©s*ffiB*a^-r4- 

2!B#> &5PS6 4- 1 8 0 0 l^£fg£M^£ftTO 
[0 0 0 6] #KIB 6 4- 1 8 0 0 1 ^&%LlZjr^tiZ> 

&wm%mm&. a£#ftft©**{M£5«£R3?©,6 40 

[0 0 0 7] 

1 8 0 0 l^&*Otttt«S«BCJ:Sfc, l£f£U> 
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[0 0 0 8] SEot, #»W©itttiU S^fb^Si.- 
^^T'§^3*x;{4g^^SJ^ffl^-^, AV3»7cta 

ass»as*is» v «k s«#t-r 5 c t c & *> . 

[0 0 0 9] **TO©ffe©i«aU 

0, »oaott&tt#-rsci:tfT-*6 3*7caiiS» 

[0 0 10] 

MEl^©^«SI±ffiBfll^©**^T*fe5. hu 
E2ooa*«±«*ffl^©S**aT-fe5 3*5cffiB*» 

[0 0 11] ±E03*7cffifi«»ai«ffl^"-^ti5^ 

2o©8^ fiU c 2_o©3B^fcjEt)S^&< fcfe 2o© 
So. 

[0 0 1 2] *^B^(i±IB©@WSHS'r^feto, ^2 
©^hLT, l^©£j&&ffi«r£¥frT-fco2o© 
fJ^^©^{utcjS^TS{4^^^-^ 

¥Btc4>&< fct, 20© 1 KB U S3 S3 

^— ^«cgih5H5ia2o©a^©ja^«feHuB3*2© 

¥B«c2*iaicffJjSbTH5l3*&< fcfe 2o©l&7n* 
-b>-9-t:«S*iR!©S3t3£K^S*b-ra*e^*» 
HuJ2S*fi^t:S^^TH583 2o©S^tt©HJ 
i3'J>& < i: 2 o© 1 Jfc7c)t-b >^±©&B£ift if U 
SiI3'>& <fc*2ool >tf±©{SB(cSt5o 
Xmrn^-Zt-athZ 2^©8#iC«fcoT«ftSilS 
fftf3£,£©{iB£:> Bul3^-^£^£ft&Bul3 2o©^ 

[0 0 13] ±l3©3*7cttBS»a«*at:i3^T, 

jH^»ftft©^ 4 >^S:2^©|g»©'>4<i: 
& lo©ta^kUTS»UTfToTt»S<, 2o 
©«a^©'>&< i:* l^©8^k*LT^8?ii53fc2iS 

ffi, feSC^i±*BLT2o©8l^©'>&<i:** lo©a 
©«a*©'>&< i:4> lo©^hLT^LTffoT-fe 
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xtz. 2 -3ffllft^#-fe>->tfcl, W, 

3, 3§4©¥B(C*ft-?ft'J»S:< i:&2oElU t- 

-eft-eftffMt s <t a iC LT * 

[0 0 14] *«Wtt±B©§«ft*ST4fc»» ^3 

ft, io©*jsi*aflt-r*wefto2-ao«»ftd 

MB3?l£ft^t)©S&C&l:T£{fit2>v-?i;, 
|g 2 0¥atCmiiS^-^t:§*ii5B5SB 2 offlH#©|& 
^fc*2*|SitJBJ«1-*«WEJSi#afcx Sii!B^20¥B 10 
tcEBSftv B5§3 2^©fS^©&#»fc*^T:I$:£ 

i, 2o© lifc^-feVltiu BuSflgftfl^cS^Tiiu 
IB 2 ocDS^fflBuiB'^* <t*2o©l &7c3fe-fe >-9" 
±©<il£iS*-f 3£§ 1 ©**#ai:, mtl'Pte <£t> 

2 ocd i ifc^Tte-fe >-y-±®esicao^-cfi!3v-^ t 
* * ft § 2 o ©*g# t: i o t aft £ n 5 miB^rofifg 

■rzm 2 ©sn^asRii-r* 3 &7GttB&»&£&B 

S«tft1-4. 20 
[0 0 15] ±ffi©3»j6ffiBSS»BS«BCi5^T, 

v-^li, 2o©|g#©'J>&< 1 o©£g##$J5g*f 

tz. 2 o©*g#©'i>& <i:*i -ooUfttfmfctiMLWiiz 
ft, WL £ ft fe © 09 □ tc <t o T ffifiE $ ft 5 <t 3 K U 
Tfc&<> 2o©*g#©'J;&< loog^tf 

ftSff, &£ott&g^£££K.fcoTtgE2£ft3«):-5£ 
TADS;* ft, Buia2r3©&#©'_Kt< 1 30 

.fcoTflWteftTfcAn. &flJfi£¥8:ti, 2o©|»»© 
«fl-*S!B3, 'SS4©^fflC-tft-tft«j3t1-*«lJES** 
U 'J>&<fc*2o©l&7G#-te>tf8u ^3, £4© 
¥HK*ft*ft'J>*t< fc* 2"3EB3ft4«J«i: b"C*» 

[0 0 16] 

immnmmm] ut» *»w©3&7GffiBJ8»w 
se^-*, fitfaftTcttBSHflia^aaiFaasia 40 

[0017] H 1 tt, #3gBJ3fflig 1 ©JBJBtactsttS 3 
*7GffiB8»fllJ£«Bft*U *tftBB2CT-*3*« 
ffM£ftfeiJSg*fi*l fc, v-^3*^tr»Baffl2 
©SW****rslS*U>X4a, 4bi:, 2^fflg 
&B7a, 7btii*h, g«fcU>X4a, 4b©« 
*£J:oTJ&fcSft£v-*B3a, 3bfc»»-J-4 1 
*7C7t-b>-9-6 a, 6b&tf6c, 6dfc, |a]Jt8f§^#S 
40SS1 0A>6>HJ2>SftS*'f S V^fl^tcS^T 1 
»7C^-fe>1t6 a, 6 b, 6 c, 6 d&igirf SiEi&ls] 50 
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SSlla, lib, 11c, lldfc. l*7C7fe-fe>-9- 

6 a, 6 b, 6 c, 6 d a»&Htfj$ft**3ISe^SJf 
lt57>712a, 12b, 12c, 12d£, ifji 
$ ft fc #&gfi^ ft x * * >HI* t SElft-T 5 A/ D BA 
§13a, 13b, 13c, 1 3 d t. xS^Ml^tc 

B*sftfc#$Ke^fc**yfflffliia8i 5*»&ma£ 

ftSBSa^B^O-S^TlBtt-J-Sfc©©/* 'J 1 4 

t, uwtsissi 5^e,te^$ft5Sc^iiibfi^!c 

S-3^T/€U 1 4A»6tH**ft4*96«(S**A*U 
T«S»ft* 1 © 3 &7C©ffiBfc«»SBJ|tr S 7n -tr 

>>+M6i:, rD-bry-tM 6tU»tS3*x;©fi[B5W c 
£&©jRIF£j|t££jFr&&^8 1 7 i:$*-fS 0 
[0 0 18] -?-*3tt, £,£P£lf-r-i>¥tTT-fc^it 
&L, , L, fefcU *fgl8®2i;5i»##lfc3M*4 

©*^ft*ffi2CK!)ftltT«J«br*fi<, 
»B«ffl 2 fcfi«*#B& *#*©»»*« 6 ttttTJB 

«L-ct>an. *jB!i«T?tt» ee©»BBB2©affl 

fcMfeM&£g:ftil,Tv-*3£ff2fi£UT^S. 
[0 0 1 9] v-* 3©Sif8|L, , L, tt3*W±*o 
TfcJK, *©5%*ttfc»fc*2#fc»a-fft«a 

cft?>©Biiiia«ii, fes^ii^a^T-fe-oT 
*ft<, jffj£©iis©»##s«sftftttfi^. 

[0 0 2 0] HI ©«fig(ciJl>Tx 1 \*mm 

t % v ^ mms^? e> $ ft s ?t w-r s c 1 1 «t o 

Tx M&^B2t^tte>ftS^-^ 3©ffJtttca^< v 
-^t3a, 3b#gftI7a, 7 bC«J«$ft*. IP 
:©?-^3a, 3 btti£fcU>X4 a, 4bC 
icTM$tlT l*5c^-b>if6 a, 6btf^(tf>ft 
^iI7a, SVl*7C*-«r>^6 c, 6d*»»Jt6 
ft5iK«®7bt:^«-ra. l&7C#-fe>-9-6a, 6 
b, 6 c, SdttlikTcCCD^SJfcB^rU'fflPTft 
!) t ^i7a, 7 bCifg&^ftav-^&S a, 3b 
#£M-f-5{i§©HSil£.fclt£7t3£J^ fiV-fffliOS 
^•©Jt^StS^^TS^U^UO^S^to-f^S 
fs^&7>7'12a, 12 b, 12 c, 12dlctB;fr-f 
5, 7>712a, 12 b, 12 c, 1 '2 d titH £ ft 
fc*5!i««^ttA/DBftSl 3 a, 13 b, 13 c, 
l 3dicj3HT7 s y*A'e^t:B8i?ft*. ^^'Jffilfl 
(5]S§1 SliXo-tr^+J-l 6^e>tB*^ft5»Jffll<s-t(cJ: 

^^tiu(f^(cs-5v^•r^ l fi^s^I^S:7•p•fe■yit 1 ec 

aj*$-a-S. 7"D-fef It 16WtU 1 4;!) 1 6A*^ft 
*7teSg{f^(ca^^TSi]^at) 1 © 3 *5ciCi5lt-S 
ffiBhSK&BIIU *©SUWS*ftai*»l 7CU1* 

[0 0 2 1] H2& *»J6«»i:lgBffl7a, 7bC 
*5l*«2ft7cB«3R©»i6Bi*ft*U BSWCBBBS 

7 a, 7b£££0 l , 0, £Wrse*U>X (H^ 



( 5 ) 



f#PB¥9- 1 1 3 2 2 4 
8 



[0 0 2 2] «s(*fifll6 (x, y, z) s 1*56** > 
it 6 a, 6b#^l*£>ftS£f£®7aT-<D2#:5GEgt£& 

(h, , v, ) , l«7c*-fe>*6c, 6d4«»tf6n 
SIS&B7 bT?©2fc7G«S£ (h, , v, ) iUt, 

C I 1 C I 2 



I*7c3te-fe>1t6 a, 6 b SWrSlift-^-f YOJi* 

/t?.rf-*C» BttS (1) (2) £*oT 

[0 0 2 3] 
[ill] 



C = 



c„ 

C 8 1 



C 22 
C 82 



C I 3 
C 23 
C 83 



[0 0 2 4] 



Cm 
[R2] 



(1) 





r Bu 


B 1 2 


B 1 3 


Bui 




B = 


B 21 


B 22 


B 23 


B t 4 


(2) 




B 3 1 


B 82 


B 33 







[o o 2 s] ttzs m^mmt^mmi a, ibizm 

Cfht fv, fr 

Cgh, gv, 1 



L t 14, SSM7a 



[0 0 2 6] v-^ SCDiS^L, 
ic^giT£-£i-£oT££Pi XtfitSLu , La £ 
^t^7-^t3a^MU b - 

^tc4oT5E,£Pi MI8L,, , La *M?Z>^-t 

[ 0 0 2 7 ] iH3 (a) 44, £fcffi7 aCJKjSEStifc^ 
-^|3a, 03 (b) 14, |gffeffl7bCJBJ«3ixfcv 
-^gl3b£^U, l*7n#-t?>1*6 a, 6bhv-^ 
taah^S^A,. 4:A„ *p6^-^&3 a©il$g 
Lu #«7G**U l«7c*-fe>1t6a, 6bi:v-^& 
3afctf&t>3j£A„ , An A»&T-*».3a©ieSL 
n #tg5££ft3o e«ftB7b«cJB«*ii*v-*flk3b 
«CO^T*>|i]»K, l*Ki^-tr>^6 c, 6dtv-^ 
g»3 bh#£t>£,£D„ hDn *p£>v-^&3 a©iS3& 

S (q (Db 

q i j 



5 2*7cSSffltt, KtfSRf, fffcffl^T 

20 

= C Cx, y, z, l) 1 (3) 

= B Cx, y, z, IT (4) 

[0 0 2 8] 114(4, *£f£S7 atc35ttS^-£»3 a 
©iSSLu , L u ®ffiBfcl*7G#-fe>iJ-6a f 6 b© 

-£©fi£8^ST-i&!K ^©f£L fl , Lu ©ffiffiTMi 
30 -b>itffltt(E<&5« <fc^>t\ ^-^i3a®I^ 
Lu , Lu ©firfiqu (i = 1, 2, j = 1 , 2) 14, 

a, a (i) -cants. 

[0 0 2 9] 
[S3] 



■D (q) ) ) 



(5) 



I (Db-D (q) ) 



;:t% D (q) (±Ei»qiCiStt5ta*fiS, DbttMf 
Chi , v, 3 1 =q Ca H , b« D 

Ca u , -b u r e*^©* 
fc^hJk Cc„ , da) 1 (41&x;#*>1t©i§!© 
BHJK©**««, qttBJMWe**. ) 

l»7C*-b>*6a, 6b±©^-^^3 aCOS 
(4, 5t (2) «Ci0e*ffi7aT-©2ft7cffi« (h 



[0 0 3 0] Sfc, i§i©l&^#i?>1t#JgglS7 
aT-©2&7cffiffl^"e 
+ Ccu , d-, D 1 <i=l, 2) 
(6) 

Vi ) (I Sift SiX-S. iot A„ -A :1 ttq„ -q :1 

£5£ (2) icftA* sc:i:fc:J:D»6ixs. LT, a 
„ £ (h u , v„ ) fc-ratS, BSL,i , L„ O^tt 
B B7 a£*tt5i»B©£Hatt 
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( : 6) ^ 1SBBT9 - 1 1 3 2 2 4 

9 10 
Ln : (h t , -h„ ) (Vi -v„ ) = (v :) - v„ ) (h t -h„ ) 

(7 ) 

Lu : (h :i -h„ ) (v t -v„ ) = (v :: -v„ ) (h t -h„ ) 

(8) 

tl%>o 

[0 0 3 2 ] -7-*3©ffi»L, , L, ®^*P©ffilt 



SbCDillBLu , Ln , Li, , L £1 icSo^T7-^3 



©ifiSL, , L: ©SjSP©(aBS*»5o *»££tt 10 „ 0£,£P. *&=^lfll*©®SicS^OT«*PS:* 



[0 0 3 3] ST, »ft%S2CDttftffiaii:lSftiB7 
a, 7b©2*7cS»©B«iC-(f*aSC (3) ^Jgl8t 
-5. 



iKo*fiD#tS#i&§#, Witt, v-^3£>«g 

f hi =C„ x + Cu y + Cn z + C„ (9) 

fv, = C„ x + C„ y + C„ z + C H (1 0) 

f =c Jt x + C„ y + C„ z + C )4 --- (1 1) 
(9) -f x (1 1) RTf (1 0) -f x (1 1) 20 

0= (C„ -C„ ht ) x + (C tt --C :i hi ) y 

+ (C» -C u hi ) z+ (C. -C„ hi ) 

(12) 

0= (C„ -C„ v t ) x + (C„ -C„ Vi ) y 

+ (C„ -C„ v, ) z+ (C 1( »C )( Vi ) 

(13) 

£tz, A (4) £it§§LT 

gh, =B„ x + B„ y + B,, z + B„ (14) 

gv, =B„ x + B„ y + B» z + B„ (1 5) 

g =B„ x + Bh y + B„ z + Bm (16) 

(14) -gx (1 6) (1 5) -gx (1 6) ± 0 

- 0= (B„ -B„ h, ) x+ (B„ -B :i h, ) y 

+ (B„ -B :1 h, ) z + (B„ -Bm h,' ) 

(17) 

0= (B n -B„ v, ) x+ (B„ -B : , v, ) y 

+ (B n ~Bn V, ) Z + (Bm "B„ V! ) 

(18) 

JC(12) (13) (17) (18)©3^ [0 0 3 4] 

t»Atf;5S<12) (13) (17)Sffl^T [»4] 

C 2 1 ll L 



F = 



Cm V L 



" C 1 4 
' C 24 
' B 14 



V = 



x 
y 

z J 



[0 0 3 5] 



r C 1 1 C a i h i 



Q = 



[»5] 

Cl2~C»2hL 



C 2 1 ~ C S ] V L C22~"Ci2Vl 



C 1 3 — C 33 h L 
C 23 — C 33 V L 



B I 1 ~~ B 3 J h R 



Big B j 2 h R 



Bis - Bash* 
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F = QV (1 9) 

tte*), (hi , v t ) £P» (h, , v» ) 

V = Q" ! F (2 0) 

[0 0 3 61 S (12) (13) (17) (18) iCS 

xic (2 0) &«*u 4a d 

lc£oT££P&5R»Tt>&^ 0 
[0 0 3 7]&£, 3*7ctl*5«t*ffl«»ft*l©«» 

hi = (C n X + Cn y + C tl Z + C, 4 ) 

/ (C lt x + C„ y + Cn z + C„ ) (2 1) 

Vi = (Cn X + C„ y + Cn Z+C« ) 

/ (Cn X + Cn y + Cn Z + Cn ) (2 2) 

ilfttK CtlSSv-^ftSaOBaU <Z)£*13 (7) CftX LT^St* h 



( ; 7) W &gB¥9- 1 1 3 2 2 4 

12 

[0 0 3 8] H2(cU^Tx ¥BF» lil/>X£*0i. 
Si^ v-^ftSaCSaU 2HF?-*3©i6aL 
. £gtf¥S, ¥SF :1 ttU>X££0i fcaO, v- 

*ik3a©ieaLa av^-^soiaaL, £§tr¥ 
itaL,, Rw->? 3<Dmmu z^tsw-m, ¥®f :i 

l±U>X±«S0. *a?K v-^»3b©iiau Xtf 
^-^©iiaL, ££tr¥fflT-&§« *|fil^^h;!/r 

[0 0 3 9] *1\ SC (3) JiDf 6iS**5fc 
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F,i 



a,i x + bn y+Cn z + du =0 



(23) 



(C 1( 
-h„ 

"Vn 



(an , 



a u x = n, 
b,i y = n, 
Cn z=n, 
du = n, 
n, - h M 
m, = v n 

b n , cu ) t&&bt>tiz>o m&icmwtzz 

i:££oT¥EF u , F,. , F a <£>i£a^ Wl/f » , 

f ,, , f II &M$>t>hZ>o 

[0 0 4 0] fc£3T\ 7-^3©tlL, tt, ¥SF 
u h¥iF„ ©3SaT-ft5Cli:^6>, #13^ Wlr, 
ii^fflFn t¥>m¥n cDiSa^h^f.i > f.i 

xmmtft&ox 

r, =fu xf„ (2 4) 

£:bT;Ktf>?>ft> Pl«t:, v-^SfciiaL, 14, WE 
F u h¥BFu ©jEat-ftSCiifre),, ^Ipf*^ Wlr 
, ii¥@F n i:¥fflF„ Ofen^Z Yfrf » , f » £*f 

r, =f « xf„ (2 5) 

r u = c o s (0, ) 
r, f = sin (5, ) 
r 

q 



(Cn -v„ Cn ) -m, 

(C„ -V„ Cn ) -m, 



(Cn -V M Cn ) -m, 



V,, C S4 ) 



-m, 



(Cn —hi, Cn ) 

(C lt "hn Cn ) 

(Cu — h u Cn ) 

(Cn — hn Cj, ) 



q = r, x r, ' (2 6) 

30 £l,X>&&)t>tiZ>o 

[0 0 4 1 ] ±|3©«ST-;Rttfcttft*ffi2©i£ 
WI/qXtfSaL, ©SlS)^ h;i/r, (CS^ 

Xs a«Wft»i©3*7ct:*tfSft» (o-;b, tr* 

[0 0 4 2] SfU^.i^Ur, ©#{4^^ b;i/r„ (r 
„ , r lf , r tl ) (tztzbr lt >0) #x«li:¥ff 
4k*. M&a^ h^q©#(4Sa^^ h^q 
. (q,, q, . q. ) (££Lq. >0) tfzfg|£:¥ 

40 WT^iiS^f^n^o 



^ h;i/q 
cos (0, 
cos (0, 
= -sin (0, ) 



= c o s (0, ) 



q. 



= s in (0, ) 



) (27) 

) (28) 

(29) 

s i n (0, ) cos (0, ) 
+ s i n (0, ) s i n (0, 
s i n (0, ) c o s (0, ) 
- c o s (0, ) s i n (0, 



) (30) 



(3 1) 



q, =cos (9, ) cos (9, ) 



(32) 



S£ (2 9) imtt&ZtlZXvXs tvT-e, tt 50 0, =-sin" (r„) 



(3 3) 



( .8 ) 
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9- 1 1 3 2 2 4 
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5£ (2 7) &tfs£ (2 8) a-;b0, l± 
6, =tan' (r„ /r„ ) (34) 

cos (0, ) =q, /cos (0, 
5£ (3 5) (3 0) tcftAf Stfciitc, 5$ (3 
3) fWct'^e, (3 4) X-&tbtza-)\> 

6, = s i n- 1 { (q, -q, • 
/sin (0, 

[0 0 4 3] 06tt, ro-fey+J- 1 6tc£ttSi1t»$0Ji 
ii*i£^-f7D— ^V-hT"^, ^T'v7S, , 10 
S, , S, , S, , Si T"^-^ 3©fi§£3fc«>SCi: 
#T-£, Xx'vXS, , S, , S, , S, , S, , 
S, , S, ■e-7-^3®»»S*»*Ci:* ! Tf**. 

[0 0 4 4] -7-^3©ff$tttt, .07 (a) {c*-f£? 
fc, ttML, , L, tt«ftT^T*©»*MLtCSE.* 

(H^*r) ^ott^<,17 (b) est* 5 

L, , L, tt l&7c#-fe>?fc < fc3S&*Bl!)7'< , > 1 8 
a, 1 8 b£^TfiSifcB^£*xixK&^c: 



StC, SC (3 2) ££ff*U 



) (35) 

6, SftXtS^ktiot, tt 



07 (c) tc^-r<fc-5£, ^jgf^T-feoTfc&^o £ 20 
fe, H7 (d) t^t«t5Cx K»L, , L, £<»3£ 
^.totMbfe^-^ft^^. ttz. 07 (e) 
3 C» ISfBSIfcil^L, , L, fcLTttflJ-f* 

*f#lt!l #:ftgiIttT-&lx«, *g^$ffllt&£*ffi© 

craPSRtt, Jf^a-»>h5h 30 

^. 

[0045] 0 8 li, 0 7 (e) C SI"*-* ©HIM* 

„ <fct>&ST-*{£3 a i: UTfiJfflt 3 &©-£-&!}, 1 
*7C7fe-fe>-^6 a, 6 bOg^tB^U^l/tcSrSOKIJi 
I£KttSCi:fc<fcoT^-*&3a©it&(ftgq. 1 ~ 
q>. Sftffll - *. 04 t;ftfit£>$#^.:■CK^TIi^«-r 
S§l/f!&*&tf3lfflf? ^ 5£P^tLT^■5©T^ aat4» 40 

[0 0 4 6] 09tt, ^ffeft^itettOiy^L, , 
L, Mt51SJtMU«^-^5a, 5bT- 

L„ , L„ * l*7c3fe-fe>-9-6 a, 6 b, 6 c, 6dT" 

[0 0 4 7] 01 0<±, feflftffi7tii»« l«7C*-b> 
It 6 a, 6b©ES©a£J&W«:^U (a)©«t-5tl 
&^ft-fe>-tt6 a, 6b&*¥frCEBUfc!», (b) 50 



cos (0, ) t an (0, ) ) 

) } (3 6) 

©J:3fciH3EUTEB-f SttfcfcLTtifii-*. 
[OO4 8]011(±, l*5£#-tr>tf6a, 6b©E 
■©lft©S«MS*-r. (a) T-(±, *ML„ #1&7G 
5t.t>it6a, 6bfcg&U fiHU #l&^ft-fe> 
it6b, BcKISBLTH*. (b) T-fct, OttLi. # 
l*7G**>*6a, 6bCJgftU ««L„ #1*70 
itt>t6c, 6di:^bTl^. (c) T-tt, mm 
L,» i ! l*%*-b>t6a, 6btgSU &&L„ 4 s 
l*7C)fe-b>-9-6 b, 6 cCgffel/TOS. (d) T- 
tt, £,6P> tf l*7c*-b>*6a, SbtioT^fiE 
StiSBttrtCffiBl/t^S. (b) Tli£,£P 

, #l»;5t7fc-t>1t6a, 6bC«fcoT}BfiE£ixSSU£ 

[0 0 4 9] 0 1 2(i, ig»U>X4at:«t^TJS«$ 
fl£^-*&3 at, |g«U>X4bCJ:oT|gftSft 
5 v-* ft 3 b i: 7 fc»tt 1 «7C*-fe > 
It 6 a, 6bC.fcoTttffi-r6 3&7cffiB$g»M££B 

45lffl»*»VSIfflW^fcl«bT^4©Tf» B»-f«K 

[0 0 5 0] T-*fc3 a©ffi&L, , L, ©£ 

jSiPtOttmKiasttw-r*. 01 3t^-rj; 

5tc, *£&H7 aT*©2&7cffilf££i>^T, 1 &7C7fe 
•fe>f6a, 6.btfv, =lWv, =-1, jk$g 
L„ , L a ©£,£# (0, w) , mULn tfUkKft-t 
>+t6 bfc&-f£g#4 5S, iSHL,, , Ln ©ft-fft 
f£#9 0gi:U C©h§©3o£Pi ©ffiffi (h, , v 
v ) ©tMtfig£fcW-f So 

[0 0 5 1 ] I*7c3fc"fe>-tt6 a, 6 blC^ltSit^L 

.i , l„ ©tttuKMtf, mmmgoi ommfr 

mzzti^tiftStg. ^.P, ©ffiS (h, , v, ) 

[0 0 5 2] 
[ft6] 



7w 2 +i 



0s 



(Ts 

[0 0 5 3] 01 4tCC©y-7 7&7F-r. w- 0©t 
-3*!»*jSIP, #l«7cife-fe>tf6a, 6b©*-ll> 
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4, a, , a, ©«*t<H±*&S#, £jftP, # 1 
ifc-fe > 6 a , 6 b ©*totft SliifttmHSaW-* 

oaisattGHrcfcs. ia:^>t6a, 6 

b 4«F1fCS! oTi'fti ^H£T- 1», H t J: 5 1 

[0 0 5 4] &{C X 121 Stz^ti^iC, Sft®7 at 
©2&5£Sffl*fc*l*T, Ufc7c*-b>*6a, 6 b, 
6c#v t = 1 s h, =- l&tfh, =1, it«Li, , 10 
L B OJSjStf (0, w) , ££L„ #l»7cJfc-fe>tf6 
afc&-ffcK#45flL SHU th a oatftK#9 

os, ofcsos^p, ©ffiti (hi , v t ) (omitim 

[0 0 5 5] l»7C*-b>-9-6 a, 6 b, 6ctC*5ttS 
a i ©IE»#*fc*ix*ftfiE3 4:S, £.£P« ©&«i 

[0056] 016 tt, ^tibaWMImgoi , ct, & 
fjito C©S&«itiML,i , L„ ©£.£Pi tffliHC* 20 

[0 0 5 7] yiffli^C lft^-fe>+J-#2o©i§ 
3o©tg£T-*K ^-^»©iffi(a©SS^tSiH©tft 
a««*'J>L/t*S5»attt, 011 (c) , (d) (c 
ifiti. o iz^-Z&om&Ott.&i* 1 *7c^-tr >tf©rt 

•SjfcStffciu ££u 3 &7G©ftS©it»tt, ££©-7 

*>*tfH*n«iB«©rt«tasi^t» 30 

[0 0 5 8] HI 7 (i, #S§(i©Sfl 2 ©ff^gC J3tt S3 

»7cafiS»ai^ssa$^i/s c©3&5utaa£i&$j£ 

PfcfSofeBttL, , L, £WfS^-*3#ffM£*l 
It, lCftttT 2 £fa*e># 

SSSW-ra^S2 1 a, 2 1bfc, §#H20fcl*5i 
^•b>-9-6a, 6b#¥fTiClSH;**ll> l*7C-f^-^ 
A^rSB 1 9 i:, l&^#-fe>1?-6 a, 6b4»6ffi*sn 
•5 I*5t'f^-V7 ? -^{C»^^T^-^3©{4^SU C 40 

[0059] 3 a, ji£ttft«i i taa*^** 

!K I*7t^-fe>it6a, 6b±T-*fi^©^fbi:L 

i^&£g:f)i*3CfcK:«fcoTffJi£;**iT^S. #&2 
la, 2 1bli, 7>722a, 2 2bA»6ffiU$ftS 
*ia*l'>X2 3a, 2 3b-eWJtkl/T«S»ft 



x= (k, 



m, 



y = (k, • m, 



x, -k, 



x, 



(;9) w 1 1 3 2 2 4 
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la, 2 1 b4»6HWS*i6*CJ;oTJK)«S*l4^- 

i?»3a, 3 b^§7 i e®2 OT-S^t?.. §;ft@2 0tc 
85lte>itTl>5 lft^-fe^tf 6 a, 6 btt£&£ft3 
v-^3a, SbCBISL,, , L :l , L„ , L : . tffg 
<SJ5«fc-5tgEa£hTHS. 3t»SB9l±, I&tg-iV- 

>Ka-*-*Tf»5. Sfc, »2©JB»tiitt*3* 
5cffiBS!»fll^«R©S'^xAras»<'Htt, H 1 2 fc 

[ 0 0 6 0 ] Jfcfc, Ml 2 ©BSlciStt £> 3 &5cftagf$ 
-at, 3&5c©tS[«i:fi»*8lll-rs*a 

[0 0 6 1]H18I±, v-* 3 tfffM^Ji'O 
ttftttl-fc, l«t>t6a, 6 b#IS:tte>ft5§ 
#H2 0fc©3i*7C&*S££*ttSfiaKfi&£^U x 
y¥@(i§^ffl2 0±C^8l,tl>*. #S2 1 a, 2 

lb (u-rtifcH^-e-f) d»6«»Sn**tS-3^T 

2 0fcS^^tl5v-^ft3 a, 3b©^r6](i, 
JjIrI^ HUk (k, , k, , k, ) > m (m, , 
m, , m. ) i:¥tT^lRlT-fe5 4©i:-r?)o 
[0 0 6 2] »C, &&2txtzT-t>m3&, 3b©iS 
HL„ , L« , L„ , L„ ©#SS£5R«>S. I&tg* 
•fe>it6a, 6bl±, 04 (c^ bfc<t 3 tc, v-^^3 
a, 3b©BHL 

-9-6 a, 6 bCDtMiff^icS^T, §#S*2 0©1* 
7c3fc-b>1tOiIJB©*Sa;i:^-^ft3a, 3b©itl& 
Lu , L u , L„ , L : , {4»A„ -An XV 

D„ -D tl A„ ^eitSILu %'&7i>L, 

An tA u 3^6iSjBLu ^rflTcbs D„ fcD„ ^e>ifi^ 
Lu SaTcU, D„ fcD„ A^it^La &{Ixi1"^o 
[0 0 6 3] fRTU^n&iiSLn , L :l , L,. , 

(7)^P ( x , y, z) ©{£g£;K#>3a ir, 
i3a©IIL u , Lu ©£.&&Pi (xl , y t ) ^ 
bOiaiSL,, , L tt o^SP, .(x, , y 
i ) ttZk, ^[rI^^ hfrkt^ h;i/PPi (i¥fT 

k t /k, =z/ (x-x, ) (3 7) 

k. /k f =2/ (y-y, ) (38) 

m, /m, =z/ (x-x, ) -— (39) 

m, /m, =z/ (y-y. ) (40) 

tf»6>*l*. 5t (3 7) (3 8) (3 9) ( 4 0 ) (DM 

m, • Xi ) / (k, • m, -k, * m, ) 

(4 1) 

■k, • m, • x t ) / (k, • m, -k, * m, ) 
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z = k, • m : (x, -x, ) / (k, 

z = k t • m t (x, -x, ) / (k, 

[0 0 6 4] &tc. v-£3©8»©*»*£ttTKK 
H^t5o ^|3a, 3b©iE»L u , L tl , L„ , 
La <D15^^ h)l&Ztl?tltii > t n , t« , t» 10 
tt&tZ, 2©ffi«'<£ h^q, ^-£3© 

IliSgL, ©Stfe^ Ml/r,^ v-£3©fi«L, ©£ 
h;i/r, (is fiJLT©^ 

r, = (t u xk) x (t,, xm) (4 4) 

r, = (t« xk) x (t» xm) (4 5) 

q = r, xr, - (4 6) 

«C«fco 6*1 5. 

[0 0 6 5] MtC, tfe£§^ h;i/£q (q, , q, > q 
, ) (fefilq, >0) , ^-^3(Dtfi^L, ©#fql^ 
*>;Vr, £ (r, , r„ , r„ ) (fc£br„ >0) 20 
t LTs ifia^h/l/qtfzttfc^ff"^ v-^3©it 
MIL, ^yitf {t^^§©v-^ 3©gU^lf^ . 

T?*UfcsS(2 1) (2 2) (2 3) iaot^SC 

[0066] hi 9 a, &w$>9izio\i%mwmm&m 

^t70-f^- hT'S 9, ^ryT'S, , 'Si , S 
, , S, f Si T-v-^30(4i^«§:i:^T*^ 
*x*7Si , Si , S, , S. , Si , S, 
3©g§fc£#*!)£;:£:#T-£3o. 30 

[0 0 6 7] &.±<DBmmx-tti. m%tt&® i £Ei*#- 

[0 0 6 8] 

«»«£ffl7-^ atf3&7GffiB£»ffl£*^U c « 

at***:* j*ftast»it6ix, io©a.6fc«»-r 

5 ¥ftT- ^ 2 o©$g#£ Str ^ - * (c is b t 'J> & < 

t, 2*© i *s*-fe>*"etftai*n'6 / >* < 2 ^® 

v-^§k«cS-3^T3Jfc7C«ci5lt*ttBi:*»fe»llt 
S«tatUfcfc«», 3Jk7cffitt«»fflSS«0«*ft6 
El^h^^tC^^ h^>£H6C^#T-#6o 
[Hifi®n#&IM!] 

[HI] **MO*10lllffi©©!B^*(t*3ft7£(il[B 
S9ii£SB * mt l&WmX' & 6 . 50 




13&W9- 1 1 3 2 2 4 
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(42) 

• m, -k, • m, ) 

(43) 

♦ m, - k, * m : ) 

(44) 

[H2] «jftfta*fcie*B«ctJltS2*7cffiS*i:0 

m&zmtmwmx&Zo 

[H4] m l«pHJfi©JBSoeftH^i5»t5 l&7G#-fe 
>*fc^-^fll©iilB©ttB©lll»S^1'l!iBBaT-fe 

[H5] »l©i^©BS«c:i5(j'*fi^©Wai©iftflBia 

[H6] »l©SlJS©JB!B«c:i3^T3ft5c©ffiBi:S» 

[H7] »l©HJfi©jKSCciJ«tav-i7©S}&MS^ 

[as] mi<Dmmmmiz&^x-?-2<Dmmzm 
»t Lxmmtz^mzmtmmx'tb&o 

[H9] i7'i:UTa!l^»fta©^y^S:* , Jffl"i'5« ■ 

«©SiB©fflBI8»&^1"KBHBI"r**So 
[110] (a) JkTf (b) ttjSfi&ffllCiSW'S 1 

*>tf©Efi©£ff5$£^?1fcWHT-a&5o 
[ill] (a) - (d) (i^- £©»#!*+) *&!§©£ 

BmzmtmwmxtbZo 

[HI 2] jfftiziy h®»JS:^tP^t-S.i)c 
[HI 3] y-^ft©ifi»©SE.*©ffiBi:2-p©l*7C 

[HI 4] HI 3CCi3(t5^-^tt©ii*l©Sja©(SiB 
h £ jaffiBfcfcB8£©»iP<H£© 4^ 7 T 3 . 

[HI 5] v-^«©ifi|ll©^*©fflBi:3o©l*7C 
5t-b>-y-©filrBH«&^-rittB8HT-fc5o • 

[HI 6] HI 5(ci3lj-^v-^^©il$|©^©{iLS 
i: ££ffiBtfttBS^©lf *fflM© ^7T'^o 

[HI 7] **M©*2©|llE©»!Bt*3tf5 3*7cfil 

[HI 8] *2©^©»5JBfc#lt£§#ffl©l»^# 
*>1f4:^-^ft©ii«©{fi[BB8fi6«:m-rKMHT-fe 

[HI 9] »2©SB«S©}E!8t:*^T3*7C©ffiBi:8 

1 , as^fttt 

2 , ftftlKiB 
3, 

3a, 3b, 

4a, 4b, gftl/>X 



(;li ) 
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5 a, 5b, »§fe.3.-y h 

6a, 6b, 6c, 6d, 1 Jk7c3fe-t 

7a, 7b, mvm 

9, mu^ 

i o , mmm^m^m 

lla, lib, 11c, lid, mW}®& 
12a, 12b, 12c, 1 2d, T>7 
13a, 13b, 13c, 13d, A/D&i 
14, * * ■ J 
1 5, ^^USJSSHB 



&P8¥ 9- 1 1 3 2 2 4 
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1 6, yotvy 

1 7 , 

18a, 18b, 18c, K&S* 5 5 >f > 

1 9, l«7C-f 

2 0 , 

L, , L, , 
P, 



10 
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SPECIFICATION 

[TITLE OF THE INVENTION] 3D Position and Posture Measuring Mark 
and 3D Position and Posture Measuring Method and Device 
[ABSTRACT] 

[Theme] To simplify an imaging unit and reduce its cost. 
[Solution Means] Mark images 3a and 3b, which are formed at 
object surface 2 of measuring object 1 and based on mark 3 having 
two straight lines L x and L 2 not parallel to each other, are 
formed and detected on image forming surfaces 7a and 7b on which 
one-dimensional optical sensors 6a and 6b are disposed, whereby 
the 3D position and posture of the mark are measured. 
[WHAT IS CLAIMED IS; ] 
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[Claim 1] A 3D position and posture measuring mark, wherein 
two line segments, which are formed within a range of a 
predetermined plane, form one intersection, and are not 
parallel to each other, are included, and the one intersection 
is a reference point for positional measurement, and the two 
line segments are reference lines for posture measurement. 
[Claim 2] A 3D position and posture measuring mark as set forth 
in Claim 1, wherein the intersection is. provided within the 
predetermined range. 

[Claim 3] A 3D position and posture measuring mark as set forth 
in Claim 1, wherein the intersection is provided outside the 
predetermined range . 

[Claim 4] A 3D position and posture measuring mark as set forth 
in Claim 2, wherein the intersection is provided outside a range 
surrounded by two segments and at least two optical sensor lines 
intersecting the two line segments. 

[Claim 5] A 3D position and posture measuring mark as set forth 
in Claim 2, wherein the intersection is provided inside a range 
surrounded by two line segments and at least two sensor lines 
intersecting the two line segments. 

[Claim 6] A 3D position and posture measuring method, wherein 
a mark, which includes two line segments which are not parallel 
to each other and form one intersection, and is displaced in 
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accordance with the displacement of a measuring object, is 
formed on a first plane at the measuring object, 
at least two one-dimensional optical sensors are disposed on 
a second plane, 

images of the two line segments included in the mark are formed 
on the second plane in two directions, and at least the two 
one-dimensional optical sensors are caused to generate light 
receiving signals indicating distribution of received light 
intensity in the length direction, 

the positions of the images of the two line segments on at least 
the two one-dimensional optical sensors are operated on the 
basis of the light receiving signals, and 

the position of the intersection formed by the two line segments 
included in the mark and the postures of the two line segments 
included in the mark are operated on the basis of the positions 
of at least the two one-dimensional optical sensors. 
[Claim 7] A 3D position and posture measuring method as set 
forth in Claim 6, wherein, in the mark, the edge of the measuring 
object is defined as at least one of the two line segments. 
[Claim 8] A 3D position and posture measuring method as set 
forth in Claim 6, wherein, in the mark, an opening for light 
transmittance defined as at least one of the two line segments 
is provided at the measuring object. 
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[Claim 9] A 3D position and posture measuring method as set 
forth in Claim 6, wherein, in the mark, a material which differs 
in light reflectance from the measuring object is applied, 
adhered, or covered and defined as at least one of the two 
segments . 

[Claim 10] A 3D position and posture measuring method as set 
forth in Claim 6, wherein, in the mark, the measuring object 
is made light transmittable, and a material which differs in 
light transmittance from the measuring object is applied, 
adhered, or covered on the measuring object, and defined as 
at least one of the two line segments. 

[Claim 11] A 3D position and posture measuring method, wherein 
at least the two one-dimensional optical sensors are disposed 
on each third and fourth plane, and 

the images of the two line segments included in the mark are 
formed at the third and fourth planes, respectively. 
[Claim 12] A 3D position and posture measuring device 
comprising : 

a mark which is formed on a first plane at a measuring object, 
includes two line segments which are not parallel to each other 
and forms one intersection, and is displaced in accordance with 
the displacement of the measuring object; 

an image forming means for forming the images of the two line 
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segments included in the mark at a second plane in two 
directions; 

at least two one-dimensional optical sensors which are disposed 
on the second plane, and output light receiving signals 
indicating distribution of received light intensity in the 
length direction on the basis of the images of the two line 
segments; 

a first operating means for operating the positions of the two 
line segments on at least the two one-dimensional sensors on 
the basis of the light receiving signals; 

a second operating means for operating the position of the 
intersection formed by the two line segments included in the 
mark and the postures of the two line segments included in the 
mark on the basis of the positions of at least the two 
one-dimensional optical sensors. 

[Claim 13] A 3D position and posture measuring device as set 
forth in Claim 12, wherein, in the mark, at least one of the 
two line segments is comprised of the edge of the measuring 
object . 

[Claim 14] A 3D position and posture measuring device as set 
forth in Claim 12, wherein the mark is comprised of an opening 
for light transmittance in which at least one of the two line 
segments are formed at the measuring object. 
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[Claim 15] A 3D position and posture measuring device as set 
forth in Claim 12, wherein, in the mark, at least one of the 
two line segments is formed by applying, adhering, or covering 
onto it a material having light reflectance differing from that 
of the measuring object. 

[Claim 16] A 3D position and posture measuring device as set 
forth in Claim 12, wherein the measuring object is formed from 
a light transmittable material, and the- mark, is arranged so 
that at least one of the two line segments is applied, adhered, 
or covered with a material having light transmittance differing 
from that of the measuring object. 

[Claim 17] A 3D position and posture measuring method as set 
forth in Claim 12, wherein the image forming means having an 
arrangement in that the images of the two line segments are 
formed on the third and fourth planes, respectively, and 
at least the two one-dimensional optical sensors are disposed 
at each third and fourth plane. 
[DETAILED DESCRIPTION OF THE INVENTION] 
[0001] 

[Field of the Invention] The present invention relates to a 
3D position and posture measuring mark and 3D position and 
posture measuring method and device, and in particular, a 3D 
position and posture measuring mark and 3D position and posture 
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measuring method and device which are simplified, reduced in 
cost, and improved in handling performance in measuring of the 
position and posture of a manipulator and rotary belt, etc. 
[0002] 

[Prior Arts] When holding and moving an object by using a 
manipulator, the position and posture of the manipulator must 
be measured at a high speed and with high precision. There 
is a prior-art 3D position and posture measuring device which 
uses an image pickup means such as a TV camera, etc . , for visual 
feedback control. By this 3D position and posture measuring 
device, the image of a measuring object is picked-up by the 
image pickup means such as a TV camera, etc., to generate 
information about the 3D position and posture, and these 3D 
positions and postures are converted into a frame of reference 
fixed in an environment, and the manipulator is moved to a 
target position in this frame of reference. 

[0003] As a measuring method of such a 3D position and posture, 
a measurement by a stereo system in which the images of three 
characteristic points of a measuring object are picked-up by 
two image pickup means is generally known, and in addition, 
in Japanese Laid-open Patent Publication No. Hei-3-135718, a 
method is disclosed whereby the images of two parallel straight 

lines are picked-up by the stereo system to grasp the 3D 

o 
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position and posture. 

[0004] However, by this 3D position and posture measuring 
device, a 2-dimensional CCD sensor is used for the image pickup 
means such as a TV camera, etc., wherein the speed to take-in 
data of one screen is 1/30 seconds or 1/60 seconds. This is 
extremely slow in comparison with the feedback cycle time of 
the motor controller of the manipulator generally being 1/1000 
seconds or less, therefore, this cannot.be adapted to a high 
speed positioning operation. Also, since the pixels of one 
screen are approximately 500 x 500, the resolution is not 
sufficient, and furthermore, since the information amount to 
be processed is large, an exclusive processing circuit is 
required in order to increase the operation speed, resulting 
in an increase in cost. 

[0005] On the other hand, a position measuring device, by which 
the position and posture of a measuring object are measured 
by measuring the reference position of the measuring object, 
is disclosed in Japanese Laid-open Patent Publication No. 
Sho-64-18001. 

[0006] By the position measuring device disclosed in Japanese 
Laid-open Patent Publication No. Sho-64-18001, a spot light 
source such as a miniature light bulb is attached at the 
reference position of the measuring object, and light from this 
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spot light source is converged by a converging optical system, 
the converged light beam is split by a beam splitter, the split 
light beams are detected by one-dimensional sensors in two 
orthogonal directions, respectively, and its sensor signal is 
inputted into a corresponding position detecting circuit, 
whereby the position of the measuring object is measured. 
[0007] 

[Themes to be Solved by the Invention] However, in the position 
measuring device of Japanese Laid-open Patent Publication No. 
Sho-64-18001, since various optical parts including an image 
forming lens, semicylindrical lens, beam splitter, etc., are 
required, the arrangement becomes complicated, and cost 
increases. Also, since a spot light source such as a miniature 
light bulb is required, careful handling is needed to prevent 
it from being broken. 

[0008] Therefore, the object of the invention is to provide 
a 3D position and posture measuring mark and a 3D position and 
posture measuring method and devices by which simplification 
is realized. 

[0009] Another object of the invention is to provide a 3D 
position and posture measuring mark, and 3D -position and 
posture measuring method and device whose cost can be reduced 
and handling performance can be improved. 
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[0010] 

[Means for Solving Themes] In order to realize the above objects, 
as the first aspect of the invention, a 3D position and posture 
measuring mark is provided which is formed within a range of 
a predetermined plane, includes two line segments which form 
one intersection and are not parallel to each other, wherein 
the one intersection is a reference point for position 
measurement, and the two line segments are reference lines for 
posture measurement. 

[0011] In the abovementioned 3D position and posture measuring 
mark, the intersection can be provided within a predetermined 
range, outside the predetermined range, outside a range 
surrounded by the two line segments and at least two sensor 
lines intersecting the two line segments, or inside a range 
surrounded by the two line segments and at least two sensor 
lines intersecting the two line segments. 

[0012] In order to realize the above objects, the second aspect 
of the invention, a 3D position and posture measuring method 
is provided, in which a mark which includes two line segments 
not parallel to each other forming one intersection, and is 
displaced in accordance with the displacement of a measuring 
object is formed at a first plane at the measuring object, at 
least two one-dimensional optical sensors are disposed at the 
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second plane, the images of the two line segments included in 
the mark are formed at the second plane in two directions, at 
least the two one-dimensional optical sensors are caused to 
generate light receiving signals indicating distribution of 
received light intensity in the length direction, the positions 
of the images of the two line segments on at least the two 
one-dimensional sensors are operated on the basis of the light 
receiving signals, and the position of the intersection formed 
by the two line segments included in the mark and the postures 
of the two line segments included in the mark are operated on 
the basis of the positions of at least the two one-dimensional 
optical sensors. 

[0013] In the abovementioned 3D position and posture measuring 
method, the mark can be arranged so that the edge of the 
measuring object is defined as at least one of the two line 
segments, an opening for light transmittance defined as at 
least one of the two line segments is provided at the measuring 
object, a material which differs in light reflectance from the 
measuring object is applied, adhered, or covered to be defined 
as at least one of the two line segments, or the measuring object 
is made light transmittable, and applied, adhered, or covered 
with a material which differs in light transmittance from the 
measuring object to be defined as at least one of the two line 
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segments. Also, at least two one-dimensional optical sensors 
are disposed at each third and fourth plane, and the images 
of the two line segments included in the mark can be formed 
at the third and forth planes, respectively. 
[0014] In order to realize the above objects, as the third 
aspect of the invention, a 3D position and posture measuring 
device is provided which comprises a mark which is formed at 
the first plane at the measuring object, includes two line 
segments not parallel to each other forming one intersection, 
and is displaced in accordance with the displacement of the 
measuring object, an image forming means for forming the images 
of the two line segments included in the mark at the second 
plane, at least two one-dimensional optical sensors which are 
disposed at the second plane and outputs light receiving 
signals indicating distribution of received light intensity 
in the length direction on the basis of the images of the two 
line segments, a first operating means for operating the 
positions of the images of the two line segments on at least 
the two one-dimensional optical sensors on the basis of the 
light receiving signals, a second operating means for operating 
the position of the intersection formed by the two line segments 
included in the mark and the postures of the two line segments 
included in the mark. 
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[0015] In the abovementioned 3D position and posture measuring 
device, the mark can be arranged so that at least one of the 
two line segments is comprised of the edge of the measuring 
object, at least one of the two line segments is comprised of 
an opening for light transmittance formed at the measuring 
object, or at least one of the two line segments is comprised 
of the measuring object applied, adhered, or covered with a 
material which differs in light reflectance from the measuring 
object. Also, the measuring object can be formed from a light 
transmittable material, and the mark can be arranged so that 
a material which differs in light transmittance from the 
measuring object is applied, adhered, or covered onto the 
measuring object to comprise at least one of the two line 
segments. The image forming means may have an arrangement in 
which the images of the two line segments are formed at each 
third and fourth plane, and at least the two one-dimensional 
optical sensors are disposed at each third and fourth plane. 
[0016] 

[Preferred Embodiment of the invention] Hereinafter, the 3D 
position and posture measuring mark and 3D position and posture 
measuring method and device of the invention shall be described 
with reference to the drawings. 

[0017] Fig. 1 shows a 3D position and posture measuring device 
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in a first embodiment of the invention, which comprises 
measuring object 1 with mark 3 formed at object surface 2, image 
forming lenses 4a and 4b for converging light reflected from 
the object surface 2 including mark 3, one-dimensional optical 
sensors 6a, 6b, 6c, and 6d which are disposed on two image 
forming surfaces 7a and 7b and pickup the mark images 3a and 
3b formed by the converged light of the image forming lenses 
4a and 4b, drive circuits 11a, lib, 11c,. and lid which drive 
the one-dimensional optical sensors 6a, 6b, 6c, and 6d on the 
basis of the timing signals outputted from synchronization 
signal generating circuit 10, amplifiers 12a, 12b, 12c, and 
12d for amplifying optical intensity signals outputted from 
the one-dimensional optical sensors 6a, 6b, 6c, and 6d, A/D 
converters 13a, 13b, 13c, and 13d for converting the amplified 
light intensity signals into digital signals, memory 14 for 
storing the light intensity signals converted into digital 
signals on the basis of write-in signals outputted from memory 
control circuit 15, processor 16 which inputs the light 
intensity signals outputted from the memory 14 on the basis 
of read-out signals outputted from the memory control circuit 
15 to operate the 3D position and posture of the- measuring 
object 1, and display 17 for displaying the operating results 
of the 3D position and posture in the processor 16. 
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[0018] The mark 3 has straight lines L x and L 2 which are not 
parallel to each other and form intersection P, and a mark can 
be formed so that a paint which differs in reflectance from 
the object surface 2 is applied on the surface, a seal, etc., 
wherein ink printed is adhered on the object surface 2, or a 
material which differs in reflectance from the object surface 
2 is adhered on the surface. In the present embodiment, black 
paint is applied on the surface of the white object surface 
2, whereby the mark 3 is formed. 

[0019] The number of straight lines L x and L 2 of the mark 3 can 
be 3 or more, and among them, only two straight lines satisfying 
the conditions are referred. These straight lines can be 
continuous or discontinuous lines, and the important point is 
that line segments of predetermined lengths can be defined. 
[0020] In the arrangement of Fig. 1, the measuring object 1 
reflects light radiated from an unillustrated illumination 
part, whereby the mark images 3a and 3b based on the shape of 
the mark 3 provided at the object surface 2 are formed on the 
image forming surfaces 7a and 7b. That is, the mark images 3a 
and 3b are converged by the image forming lenses 4a and 4b, 
and formed on the image forming surface 7a provided with the 
one-dimensional optical sensors 6a and 6b and image forming 
surface 7b provided with the one-dimensional optical sensors 
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6c and 6d. The one-dimensional optical sensors 6a, 6b, 6c, and 
6d are one-dimensional CCD or light receiving element arrays, 
etc., which output light intensity signals indicating 
distribution of the light receiving level to the amplifiers 
12a, 12b, 12c, and 12d on the basis of the light intensity of 
the pixel at the intersecting position of the mark images 3a 
and 3b formed on the image forming surfaces 7a and 7b, and light 
intensity at the other position. The light intensity signals 
amplified by the amplifiers 12a, 12b, 12c, and 12d are converted 
into digital signals by the A/D converters 13a, 13b, 13c, and 
13d. The memory control circuit 15 outputs write-in signals 
and read-out signals by the control signals outputted from the 
processor 16, causes the memory 14 to store the light intensity 
signals on the basis of the write-in signals, and causes the 
processor 16 to output the light intensity signals on the basis 
of the read-out signals. The processor 16 operates the 3D 
position and posture of the measuring object 1 on the basis 
of the light intensity signals inputted from the memory 14, 
and causes the display 17 to output the operation results. 
[0021] Fig. 2 shows the corresponding relationship between the 
object frame of reference and a 2-dimensional frame of 
reference at the image forming surfaces 7a and 7b, wherein the 
image forming surfaces 7a and 7b are formed as an imaginary 
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optical system arrangement disposed in front of the image 
forming lenses (not illustrated) having principal points 0 L 
and 0 R/ and in the description below, for ease in explanation, 
this optical system arrangement is used. 

[0022] The object coordinates are (x, y, z), 2-dimensional 
coordinates at the image forming surface 7a provided with 
one-dimensional sensors 6a and 6b are (h L , v L ) , and 2- 
dimensional coordinates at the image .forming surface 7b 
provided with the one-dimensional optical sensors 6c and 6d 
are (h R , v R ) , whereby, when the camera parameter of the image 
pickup unit having the one-dimensional optical sensors 6a and 
6b is C, the camera parameter of the image pickup unit having 
the one-dimensional optical sensors 6c and 6d is B, and the 
camera parameters C and B are expressed by the formulas (1) 
and (2), respectively. 
[0023] 

[Expression 1] 



C = 



c ll c 12 c 13 c 14 
C 21 C 22 C 23 C 24 
C 31 C 32 C 33 C 34 



— (1) 



[0024] 



[Expression 2] 
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B = 



B ll B 12 B 13 B 14 
B 2 i B 2 2 B 23 B 24 
B 31 B 32 B 33 B 34 



— (2) 



[0025] Also, the object coordinates and the 2-dimensional 
coordinates at the image forming surfaces 7a and 7b can be 
expressed as follows by using parameters f and g: 

[fh L fv L f] t = C [x, y, z, l] t — (3) 

[gh R gv R g]' = B [x, y, z, l] t — (4) 
Herein, [ ] t indicates transposition of a matrix. 
[0026] The straight lines 1^ and L 2 of the mark 3 form a mark 
image 3a having intersection P L and straight lines L 1L and L 2L 
by being formed at the image forming surface 7a, and form a 
mark image 3b having intersection P R and straight lines L 1R and 
L 2R by being formed at the image forming surface 7b. 
[0027] Fig. 3(a) shows the mark image 3a formed at the image 
forming surface 7a, and Fig. 3 (b) shows the mark image 3b formed 
at the image forming surface 7b, wherein the straight line L 1L 
of the mark image 3a is restored from the points A u and A 21 at 
which the one-dimensional optical sensors 6a and 6b and the 
mark 3a intersect, and the straight line L 2L of the mark image 
3a is restored from the points A 12 and A 22 at which the one- 
dimensional optical sensors 6a and 6b and mark image 3a 
intersect. Likewise, as for the mark image 2b formed at the 
image forming surface 7b, the straight line L 1R of the mark image 
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3a is restored from the points D u and D 21 at which the one- 
dimensional optical sensors 6c and 6d and the mark image 3b 
intersect, and the straight line L 2R of the mark image 3b is 
restored from the points D 12 and D 22 at which the one-dimensional 
optical sensors 6c and 6d and the mark image 3b intersect. 
[0028] Fig. 4 shows the relationship between the positions of 
the straight lines L 1L and L 2L of the mark image 3a at the image 
forming surface 7a and the signal output of the one-dimensional 
optical sensors 6a and 6b, wherein the straight lines L x and 
L 2 are lines each having a fixed width, and at the portions 
of their images L 1L and L 2L , the sensor values decrease. 
Therefore, as shown in Fig. 5, the position q tj (i-1 or 2, j=l 
or 2) of the straight line L 1L or L 2L of the mark image 3a is 
calculated as, for example, a gravity position of the portion 
shown by diagonal lines by using proper pixel data near the 
positions within a range lower than the threshold value I . The 
gravity position at this time is operated by formula (1), 
for example. 
[0029] 

[Expression 3] 



Herein, D(q) shows the output value at the pixel q, and Db shows 
the background level. 



£ {q (Db - D(g) ) } 
Z (Db - D(q) ) 



-— (5) 
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[0030] Also, when the ith one-dimensional optical sensor at 
the image forming surface 7a is expressed in a 2-dimensional 
frame of reference as follows: 

[h L , v L r = q [a Li , b u ] e + [c Li , d hi V (i=l, 2) (6) 

(herein, [a Li , b Li ]< shows a directional vector of the size of 
a pixel pitch, [c Li , d Li ] e shows the center coordinates of the 
pixel at the end of the one-dimensional optical sensor, and 
q shows the pixel number) , the position .of the mark image 3a 
on the one-dimensional optical sensors 6a and 6b is converted 
into 2-dimensional coordinates (h L , v L ) at the image forming 
surface 7a. Therefore, A n through A 22 are obtained by 
substituting q u through q 22 for the formula (2) . And, when A ±j 
is (h i3 , v^), the equations of the straight lines L 1L and L 2L 
at the image forming surface 7a are as follows: 

L 1L : (h 21 - h u ) (v L - v n ) = (v 21 - v u ) (h L - h u ) — (7) 
L 2L : (h 22 - h 12 ) (v L - v 12 ) = (v 22 - v 12 ) (h L - h 12 ) — (8) 
As for D u through D 22 , a similar mathematical operation is 
performed, whereby the equations of the straight lines L 1R and 
L 2R at the image forming surface 7b can be obtained. 
[0031] Next, on the basis of the straight lines L 1L , L 2L , L 1R , 
and L 2R of the mark images 3a and 3b calculated by the above 
processes, the intersection P of the straight lines and L 2 
is calculated. There are some calculation methods, for example, 
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wherein the equations of the straight lines L x and L 2 of the 
mark 3 in the object frame of reference are calculated, and 
their intersection can be operated. However, due to reading 
errors by the image pickup element and model errors when 
picking-up the image, the straight lines L x and L 2 to be operated 
may have a skewed relationship. In such a case, it is also 
considered that the middle point on the straight lines L x and 
L 2 in a condition where the straight lines L x and L 2 are closest 
to each other is defined as the intersection P. 
[0032] As another method for calculating the position of the 
intersection P of the straight lines L x and L 2 of the mark 3, 
from the intersection P L of the straight lines L 1L and L 2L and 
the intersection P R of the straight lines L 1R and L 2R in the 
2-dimensional frame of reference of the image forming surfaces 
7a and 7b, on the basis of the principle of triangulation, the 
intersection P is calculated. Hereinafter, a method for 
operating the intersection P on the basis of the principle of 
triangulation shall be described. 

[0033] First, formula (3), which is a relational equation of 
the object coordinates of the object surface 2 and the 2- 
dimensional coordinates of the image forming surfaces 7a and 
7b, is expanded. 

fh L = C n x + C 12 y + C 13 z + C 14 — (9) 
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fv L = C 21 x + C 22 y + C 23 z + C 24 (10) 

f = C 31 x + C 32 y + C 33 z + C 3 < — (11) 
From (9) -fx (11) and (10) -fx (11), the following formulas are 
obtained: 

0 = (C u - C 31 h L )x + (C 12 - C 32 h L ) y 

+ (C 13 - C 33 h L ) z + (C 14 - C 34 h L ) — (12) 

0 = (C 21 - C 31 v L )x + (C 22 - C 32 vj y 

+ (C 23 - C 33 v L ) z + .(C 24 - C 34 vj — (13) 
Also, formula (4) is expanded: 

gh H = B n x + B 12 y + B 13 z + B 14 — (14) 

9 v r = B 21 x + B 22 y + B 23 z + B 24 (15) 

g = B 31 x + B 32 y + B 33 z + B 34 (16) 

From (14)-gX(i6) and (15)-gX(l6), the following formulas are 
obtained: 

0 = (B 1L - B 21 h R ) x + (B 12 - B 32 h R ) y 

+ (B 13 - B 33 h R ) z + (B 14 - B 34 h R ) — (17) 
0 = (B n - B 21 v R ) x + (B 22 - B 32 v R ) y 

+ (B 23 - B 33 v R ) z + (B 24 - B 34 v R ) — (18) 
Among formulas (12), (13), (17), and (18), for example, by using 
formulas (12), (13), and (17), the following formulas are 
obtained: 
[0034] 

[Expression 4] 
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C 34 h L 


- c 14 




X 


F = 


C 34V L 


- c 24 


, v = 


y 




_ B 34 h R 


" B 14_ 




z 



[0035] 

[Expression 5] 





- c u 


" C 31 h L 


C 12 


- C 32 h L 




~ C 33 h L 


Q = 


^21 


- C 31 v L 


^22 


" C 32 v L 


^23 


" C 33 v L 






- B 31 h R 


Bl2 


- B 32 h R 


B 13 


~ B 33 h R 



whereby, 

F = QV — (19) , and 
when (h L , v L ) are the coordinates of P L , and (h R/ v R ) are the 
coordinates of P R , if an inverse matrix of Q exists, 

V = Q" 1 f — (20) , 
therefore, the 3D position of the intersection P can be 
calculated. 

[0036] There are four patterns for selecting three formulas 
on the basis of formulas (12), (13), (17), and (18), however, 
formula (20) is operated for each formula, and at last, the 
average of the 4 patterns is calculated, whereby the 
intersection P can be calculated. 

[0037] Next, a method for calculating the 3D posture of the 
measuring object 1 shall be described. The 3D posture of the 
measuring object can be expressed by means of roll, pitch, yaw, 
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and Eulerian angle, etc., and calculated by specifying the 
directional vector r x of the straight line L x and the directional 
vector r 2 of the straight line L 2 of the mark 3. Hereinafter, 
the method for calculating the directional vectors r x and r 2 
is described. 

[0038] In Fig. 2, plane F 1L is a plane which passes through a 
lens principal point 0 L and includes the straight line L 1L of 
the mark image 3a and straight line L x of the mark 3, plane 
F 2L is a plane which passes through the lens principal point 
0 L and includes the straight line L 2L of the mark image 3a and 
the straight line L 2 of the mark 3, plane F 1R is a plane which 
passes through the lens principal point 0 R and includes the 
straight line L 1R of the mark image 3b and the straight line 
Li of the mark 3, and plane F 2R is a plane which passes through 
the lens principal point 0 R and includes the straight line L 2R 
of the mark image 3b and the straight line L 2 of the mark 3. 
To calculate the directional vector r x , an equation of the plane 
F 1L is calculated. 

[0039] First, when f is eliminated from formula (3), 
h L = (C n x + C 12 y + C 13 z + C 14 ) 

/ (C n x + C 31 y + C 33 z + C 34 ) (21) 

v L = (C 21 x + C 22 y + C 23 z + C 24 ) 

/(C 31 x + C 32 y + C 33 z + C 34 ) — (22) 
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and if these values are substituted for formula (7) of the 
straight line L 1L of the mark image 3a, 
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whereby, the normal vector f 1L of the plane F 1L can be calculated 
to be (a 1L , b 1L/ c 1L ) . By performing a similar mathematical 
operation, the normal vectors f 2L , f 1R , and f 2R of the planes 
F 2L' anc * F 2r can ^ e calculated. 

[0040] Since the straight line L x of the mark 3 is the 
intersecting line of the plane F 1L and plane F 1R , the directional 
vector r x is perpendicular to the normal vectors f 1L and f 1R of 
the planes F 1L and F 1R , the r x is calculated as follows: 

*i = f lL x fi R (24) 

and likewise, since the straight line L 2 of the mark 3 is the 
intersecting line of the planes F 2L and F 2R , the directional 
vector r 2 is perpendicular to the normal vectors f 2L and f 2R of 
the planes F 2L and F 2R , r 2 is calculated as follows: 

r 2 - f 2L Xf 2R — (25) 
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Also, since the normal vector q of the object surface 2 is 
perpendicular to the directional vectors r x and r lf q is 
calculated as follows: 
q = r^r 2 — (26) 
[0041] Next, on the basis of the normal vector q of the object 
surface 2 and the directional vector r x of the straight line 
L x calculated in the above processes, the process for operating 
the 3D posture (roll, pitch, and yaw) of the measuring object 
1 is described below. 

[0042] If the posture of the mark 3 when the unit vector r le 
( r ix/ r iy r l2 ) (r lx >0) of the directional vector r x becomes 
parallel to the x axis, and the unit normal vector q e (q x , q y , 
q 2 ) (q 2 >0) of the normal vector q becomes parallel to the z axis 
is defined as a reference posture, the following relational 
equation can be obtained. 

r lx =cos(0 r ) cos(0 p ) — (27) 

r ly =sin(0 r ) cos(0 p ) — (28) 

r l2 = -sin(0 p ) — (29) 

q x = cos(0 r ) sin(0 p ) cos(0 y ) 

+ sin(0 r ) sin(0 y ) — (30) 

q y = sin(0 r ) sin(0 p ) cos(0 y ) 

- cos(0 r ) sin(0 y ) — (31) 

q z = cos(0 p ) cos(0 y ) — (32) 
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By transforming formula (29), the pitch 0 p can be calculated 
as follows: 

0 p = -sin" 1 (r l2 ) — (33) 
From formulas (27) and (28), the roll0 r can be calculated as 
follows : 

6 r = tan" 1 (r ly /r lx ) — (34) 
And furthermore, formula (32) is transformed: 

cos(9 y ) = q 2 /cos(0 p ) — (35) 
And, by substituting formula (35) for formula (30), and by 
substituting the pitch 0 p calculated by formula (33) and roll 
6 T calculated by formula (34), the yaw 0 y can be calculated 
as follows: 

9 y = sin-l{(q x - q 2 • cos(0 y ) tan(0 p )) 
/ sin(0 r )} —(36) 
[0043] Fig. 6 is a flow chart showing the mathematical operation 
processing process in the processor 16, wherein the position 
of the mark 3 can be calculated by steps S x , S 2/ S 3 , S 4 , and S s , 
and the posture of the mark 3 can be calculated by steps S 1 , 

S 3 , Sg, S 7 , S3, and Sg. 
[0044] In the form of mark 3, as shown in Fig. 7 (a) , the straight 
lines L x and L 2 are apart from each other, and on their extending 
lines, an intersection (not illustrated) can be provided, or 
as shown in Fig. 7(b), the straight lines can intersect each 
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other. Also, since the straight lines Lj and L 2 of the mark 3 
are only detected at the reading lines 18a and 18b by the 
one-dimensional optical sensors as straight lines, as shown 
in Fig, 7(c), the lines can be discontinuous. Also, as shown 
in Fig. 7 (d) , the mark can be formed so that the straight lines 
L x and L 2 are hollowed. Also, as shown in Fig. 7(e), the mark 
3 can be formed so that the outline is used as the straight 
lines L x and L 2 . Also, the mark 3 can be formed so as to be 
provided with a groove and convex part. Also, a linear light 
source can be used, and fluorescent paint can be applied on 
the mark. Also, if the measuring object 1 is light transmittable, 
the mark 3 can be formed from a material which differs in light 
transmittance from the measuring object. Furthermore, if the 
object to be measured is a thin member like a plate, an opening 
is provide in place of the mark 3 to sandwich the measuring 
object 1, and leaked light which is radiated from the opposite 
side of the image pickup unit 5 is detected. 
[0045] In Fig. 8, the outline of the mark shown in Fig. 7(e) 
is defined as the straight lines L L and L 2 , and their images 
are picked-up by an image pickup unit (not illustrated) , and 
used as the mark image 3a comprising two straight lines L 1L and 
L 2L having intersection P L , and by setting predetermined 
threshold value I to the signal output levels of the one- 
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dimensional optical sensors 6a and 6b, the straight line 
positions q n through q 22 of the mark image 3a are detected. Since 
parts which are commonly used in Fig. 4 are attached with common 
reference numbers and reference symbols, overlapping 
descriptions thereof are omitted. 

[0046] In Fig. 9, the image of the measuring object 1 having 
the linear edges L x and L 2 which are not parallel to each other 
is arranged so as to be picked-up by the image pickup units 
5a and 5b, wherein the edge images L 1L , L 2L , L 1R , and L 2R are 
detected by the one-dimensional optical sensors 6a, 6b, 6c, 
and 6d, whereby the edges L x and L 2 of the measuring object 1 
can be made to take the place of the mark. 

[0047] Figs. 10 show modified examples of the disposition of 
the one-dimensional optical sensors 6a and 6b at the image 
forming surface 7, wherein the one-dimensional optical sensors 
6a and 6b can be disposed not parallel to each other as shown 
in (a) , or the sensors can be disposed orthogonal to each other 
as shown in (b) . 

[0048] Figs . 11 show other modified examples of the disposition 
of the one-dimensional optical sensors 6a and 6b. In (a), the 
image of the straight line L 1L is formed at the one-dimensional 
optical sensors 6a and 6b, and the image of the straight line 
L 2L is formed at the one-dimensional optical sensors 6b and 6c. 
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In (b) , the image of the straight line L 1L is formed at the 
one-dimensional optical sensors 6a and 6b, and the image of 
the straight line L 2L is formed at the one-dimensional optical 
sensors 6c and 6d. In (c) , the image of the straight line L 1L 
is formed at the one-dimensional optical sensors 6a and 6b, 
and the image of the straight line L 2L is formed at the 
one-dimensional optical sensors 6b and 6c. In (d) , the 
intersection P L is positioned within a .range formed by the 
one-dimensional optical sensors 6a and 6b. On the other hand, 
in (b) , the intersection P L is positioned outside the range 
formed by the one-dimensional optical sensors 6a and 6b. 
[0049] Fig. 12 shows a modified example of the 3D position and 
posture measuring device by which the mark image 3a formed by 
the image forming lens 4a and the mark image 3b formed by the 
image forming lens 4b are detected by the one-dimensional 
optical sensors 6a and 6b provided at the image forming surface 
7. Since the parts commonly used in Fig. 1 are attached with 
common reference numbers and reference symbols, overlapping 
descriptions thereof are omitted. 

[0050] Next, detecting precision of the intersection P L of the 
straight lines L x and L 2 of the mark image 3a is examined. For 
example, as shown in Fig. 13, in the 2-dimensional frame of 
reference at the image forming surface 7a, as for the one- 
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dimensional optical sensors 6a and 6b, v L = 1 and v L = -1, 
respectively, the intersection of the straight lines L 1L and 
L 2L is (0, w), an angle between the straight line L 1L and the 
one-dimensional optical sensor 6b is 45°, and an angle between 
the straight lines L 1L and L 2L is 90°, whereby detecting errors 
of the coordinates (h L , v L ) of the intersection P L at this time 
are examined. 

[0051] When the detecting errors of the straight lines L 1L and 
L 2l by the one-dimensional optical sensors 6a and 6b are at an 
average of 0 and follow the regular distribution of standard 
deviation cr s , if the detecting errors of the coordinates (h L , 
v L ) of the intersection P L are simulated, their standard 
deviations a h and a v are approximated as follows: 
[0052] 

[Expression 6] 

cr h ^ q v ^ Vw 2 + 1 

[0053] A graph thereof is shown in Fig. 14. When w=0, that is, 
the closer the intersection P L to the center of the one- 
dimensional optical sensors 6a and 6b, the higher the detecting 
precision. Even when the inclination of the straight line L 1L 
and the value of the angle between the straight lines L 1L and 
L 2L are different, although the absolute values of the 
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deviations <r h and cr v are different, the characteristic, in that 
the closer the intersection P L to the center of the one- 
dimensional optical sensors 6a and 6b, the higher the detecting 
precision, is maintained. Likewise, even when the one- 
dimensional optical sensors 6a and 6b are not parallel to each 
other, the more relatively inner the position of the 
intersection P L of the straight lines L 1L and L 2L , the higher 
the detecting precision. This fact is confirmed by the 
simulation. 

[0054] Next, as shown in Fig. 15, in the 2-dimensional frame 
of reference at the image forming surface 7a, the detecting 
precision of the coordinates (h L , v L ) of the intersection P L , 
when v L = 1, h L = -1, and h L = 1 in the one-dimensional optical 
sensors 6a, 6b, and 6c, the intersection of the straight lines 
L 1L and L 2L is (0, w) , the angle between the straight line L 1L 
and the one-dimensional optical sensor 6a is 45°, and the angle 
between the straight lines L 1L and L 2L is 90°, is inspected'. 
[0055] When the detecting errors of the positions of the 
straight lines L 1L and L 2L by the one-dimensional optical sensors 
6a, 6b, and 6c follow the average of 0 and the regular 
distribution of the standard deviation cr s , the detecting 
errors of the coordinates (h L , v L ) of the intersection P L are 
simulated. 
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[0056] Fig. 16 shows the standard deviations cr h ando* v . Also 
in this case, the more inner the position of the intersection 
P L of the straight lines L 1L and L 2L , the higher the detecting 
precision. 

[0057] As described above, even in a case where the number of 
one-dimensional optical sensors is 1, 2, or 3, in order to 
increase the detecting precision of the intersection position 
of the straight lines of the mark image, as shown in Figs . 11(c) 
and (d) , the mark image and the one-dimensional optical sensors 
must be set so that the intersection of the straight lines of 
the mark image is positioned inside the one-dimensional optical 
sensors. Also, in the operation of the 3D position, since the 
data of the intersection position of the left and right mark 
images is used, in order to increase the measuring precision, 
it is desirable the mark and one-dimensional optical sensors 
are disposed so that the intersection of the straight lines 
of the mark images are positioned inside the range surrounded 
by the one-dimensional optical sensors. 

[0058] Fig. 17 shows a 3D position and posture measuring device 
in the second embodiment of the invention, wherein this 3D 
position and posture measuring device is made from a light 
transmittable material, and comprises measuring object 1 in 
which mark 3 having straight lines L 2 and L 2 forming intersection 
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P is formed at the object surface 2, light sources 21a and 21b 
which radiates light from two directions toward the measuring 
object 1, one-dimensional image input part 19 in which 
one-dimensional optical sensors 6a and 6b are disposed parallel 
to each other at light receiving surface 20, and operation part 
9 for operating the 3D position and posture of the mark 3 on 
the basis of the one-dimensional image data outputted from the 
one-dimensional optical sensors 6a and 6b. 

[0059] The mark 3 is only arranged so as to be different in 
transmittance from the measuring object 1, and so that its 
position is detected by the one-dimensional optical sensors 
6a and 6b as a change in distribution of light intensity, and, 
for example, the mark is formed by being applied with paint 
whose transmittance is low. The light sources 21a and 21b 
radiate light radiated from lamps 22a and 22b toward the 
measuring object 1 by light projecting lenses 23a and 23b as 
parallel light- The one-dimensional image input part 19 
receives mark images 3a and 3b formed by light radiated from 
the light sources 21a and 21b at the light receiving surface 
20. The one-dimensional optical sensors 6a and 6b provided at 
the light receiving surface 20 are disposed so as to be 
traversed by the straight lines L 1L , L 2L , L 1R , and L 2R of the 
projected mark images 3a and 3b. The operation part 9 is a 
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microcomputer, etc., equipped with an interface function with 
the one-dimensional image input part. Also, since the system 
block diagram of the 3D position and posture measuring device 
in the second embodiment is in common with Fig. 12, overlapping 
description thereof is omitted. 

[0060] Next, the method for operating the 3D position and 
posture by the 3D position and posture measuring device of the 
second embodiment shall be described. 

[0061] Fig. 18 shows the positional relationship between the 
measuring object 1 with mark 3 formed and the light receiving 
surface 20 provided with the one-dimensional optical sensors 
6a and 6b in the 3D frame of reference, and the xy plane is 
defined above the light receiving surface 20 . Based on the light 
radiated from the light sources 21a and 21b (both 
unillustrated) , the directions of the mark images 3a and 3b 
projected onto the light receiving surface 20 are defined 
parallel to the directional vectors k (k x , k y , k z ) and m (m,, 
my, m s ) . 

[0062] Next, an equation of the straight lines L 1L , L 2L , L 1R , 
and L 2R of the projected mark images 3a and 3b is provided. As 
shown in Fig. 4, the one-dimensional optical sensors 6a and 
6b output detecting signals in accordance with the light 
intensity at the position intersecting with the straight lines 
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L 1L/ L 2L , L lR , and L 2R of the mark images 3a and 3b. On the basis 
of the detecting signals of the optical sensors 6a and 6b, the 
equation of the straight lines of the one-dimensional optical 
sensors of the light receiving surface 20 and the positions 
A n through A 22 and D n through D 22 intersecting with the straight 
lines L 1L , L 2L , L 1R/ and L 2R are calculated, whereby the straight 
line L 1L is restored from the A n and A 22 , the straight line L 2L 
is restored from the A 12 and A 22 , the straight line L 1R is restored 
from D u and D 21 , and the straight line L 2R is restored from D 12 
and D 22 . 

[0063] Next, from the restored straight lines L 1L , L 2L , L 1R , and 
L 2R , the intersection P (x, y, z) of the straight lines L x and 
L 2 of the mark 3 at the object surface 2 is calculated. First, 
when the intersection of the straight lines L 1L and L 2L of the 
mark image 3a is P L (x L , y L ) , and the intersection of the straight 
lines L 1R and L 2R of the mark image 3b is P R (x R , y R ) , since the 
directional vector k and the vector PP L are parallel to each 
other, the following relational formulas are obtained: 

k z / k x = z/(x-x L ) — (37) 

K i K = z /<Y-Yl) — (38) 
Also, since the directional vector m and the vector PP R are 
parallel to each other, the following relational formulas are 
obtained: 
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m z / m x = z/(x-x R ) — (39) 
/ my = z/(y-y R ) — (40) 

When simultaneous equations of the formulas (37) , (38), (39), 
and (40) are calculated, the following formulas are obtained: 
x = (k x -m z -x R - k z -m x -x L ) / (k x -m z - k z -mj — (41) 
y = (k y -m 2 -x R - k 2 -m y -x L ) / (k y -m 2 - k.-iriy) — (42) 
z = (k 2 -m 2 (x R - x L ) / (k x -m 2 - k^mj — (43) 

or 

z = (k 2 -m 2 (x R - x L ) / (k y -m 2 - k y -mj — (44) 

whereby, the position of the intersection P is calculated. 
[0064] Next, the method for calculating the posture of the mark 
3 is described below. When the directional vectors of the 
straight lines L 1L , L 2L , L 1R , and L 2R of the mark images 3a and 
3b are t 1L , t 2L , t 1R , and t 2R/ respectively, the normal vector 
q of the object surface 2, directional vector r x of the straight 
line Li of the mark 3, and directional vector r 2 of the straight 
line L 2 of the mark 3 are calculated by the following formulas: 

*i = (t 1L Xk) x (t 1R x m ) (44) 

r 2 = (t 2L Xk) x (t 2R x m) — (45) 

q = r 1 Xr 2 -—(46) 
[0065] Furthermore, when the normal vector is q (q x , q y , qj 
(q 2 >0), the directional vector r x of the straight line L t of 
the mark 3 is (r lx , r ly , r l2 ) (r ly > 0), the normal vector q is 
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parallel to the z axis, and the posture of the mark 3 when the 
straight line L x of the mark 3 is parallel to the y axis is 
a reference posture, the inclinations about the respective axes 
of coordinates can be calculated by the formulas (21), (22), 
and (23) shown in the first embodiment. 

[0066] Fig. 19 is a flow chart showing the operating process 
of the operation part 9, wherein the position of the mark 3 
can be calculated in steps S x , S 2 , S 3 , S 4 , and S 5 , and the posture 
of the mark 3 can be calculated in steps S x , S 2 , S 3 , S 6 , S 7 , and 
S 8 . 

[0067] In the above embodiments, in a case where reflected light 
is used for the measuring object 1, or light transmitted through 
the measuring object 1 is used, the object surface 1 onto which 
the mark is formed must be a plane within the range detected 
by the one-dimensional optical sensors. However, even when the 
object surface is not completely a plane, for example, even 
when it is a gently curved surface, with precision in accordance 
with the curving degree, the 3D position and posture can be 
measured. 
[0068] 

[Effects of the Invention] As described above, according to 
the 3D position and posture measuring mark, and 3D position 
and posture measuring method and device of the invention, since 
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the 3D position and posture are operated on the basis of at 
least two mark images detected by at least two one-dimensional 
optical sensors in accordance with a mark which is provided 
on the object surface and includes at least two line segments 
not parallel to each other forming one intersection, the 3D 
position and posture measuring device can be simplified and 
reduced in cost. 

[BRIEF DESCRIPTION OF THE DRAWINGS] 

[Fig. 1] An explanatory view showing the 3D position and posture 
measuring device in the first embodiment of the invention. 
[Fig. 2] An explanatory view showing the relationship between 
the object frame of reference and two-dimensional frame of 
reference at the image forming surface. 

[Figs. 3] Explanatory views showing the mark images formed at 
the image forming surfaces. 

[Fig. 4] An explanatory view showing the relationship between 
the one-dimensional optical sensors at the image forming 
surfaces and the positions of the straight lines of the mark 
images in the first embodiment. 

[Fig. 5] An explanatory view of the calculation of the center 
of gravity in the first embodiment. 

[Fig. 6] A flow chart in order to operate the 3D position and 
posture in the first embodiment. 



-39- 




[Figs. 7] Explanatory views showing modified examples of the 
mark in the first embodiment. 

[Fig. 8] An explanatory view showing a modified example in which 
the outline of the mark is used as straight lines in the first 
embodiment . 

[Fig. 9] An explanatory view showing the positional 
relationship between the one-dimensional optical sensors and 
the straight lines of the mark images at the image forming 
surfaces in the modified example in which the edge of the 
measuring object is used as a mark. 

[Figs. 10] (a) and (b) are explanatory views showing modified 
examples of the disposition of the one-dimensional optical 
sensors at the image forming surfaces. 

[Figs. 11] (a) through (d) are explanatory views showing the 
modified examples of the mark reading form. 

[Fig. 12] An explanatory view showing a modified example of 
the image pickup unit. 

[Fig. 13] An explanatory view showing the positional 
relationship between the position of the intersection of the 
straight lines of the mark images and the standard deviation 
of an intersection position detecting error in Fig. 13. 
[Fig. 15] An explanatory view showing the positional 
relationship between the position of the intersection of the 
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straight lines of the mark images and the three one-dimensional 
optical sensors. 

[Fig. 16] A graph of the standard deviation between the 
intersection position of the straight lines of the mark images 
and the intersection position detecting error in Fig. 15. 

[Fig. 17] An explanatory view showing the 3D position and 
posture measuring device in the second embodiment of the 
invention . 

[Fig. 18] An explanatory view showing the positional 
relationship between the one-dimensional optical sensors of 
the light receiving surface and the straight lines of the mark 
images in the second embodiment. 

[Fig. 19] A flow chart in order to operate the 3D position and 
posture in the second embodiment. 
[Description of Symbols] 

1 measuring object 

2 object surface 

3 mark 

3a, 3b mark images 

4a, 4b image forming lenses 

5a, 5b image pickup units 

6a, 6b, 6c, 6d one-dimensional optical sensors 
7a, 7b image forming surfaces 
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9 operation part 

10 synchronization signal generator 
11a, lib, 11c, lid drive circuits 
12a, 12b, 12c, 12d amplifiers 

13a, 13b, 13c, 13d A/D converters 

14 memory 

15 memory control circuit 

16 processor 

17 display 

18a, 18b, 18c reading lines 

19 one-dimensional image input part 

20 light receiving surface 

L lf L 2 straight lines of the mark 

L lf L 2 straight lines of the mark images 

P intersection of the mark 

P 1 intersection of the mark images 
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[Fig. 6] 



At the left and right image forming surfaces 7a 
and 7b, straight line position qij of mark images 
3a and 3b on one-dimensional optical sensors 
6a, 6b, 6c, and 3d is calculated. 
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At the left and right image forming surfaces 7a 
and 7b, straight line positions An through A22 
and D11 through D22 of mark images 3a and 3b 
are calculated. 
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At the left and right image forming surfaces 7a 
and 7b, equations of straight lines Lil, L2L, Lir, 
and L2R of mark images 3a and 3b are 
calculated. 
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Normal vectors of planes Fu, 
F2L, Fir, and F2R each of which 
passes through the principal 
points of the left and right lenses 
4a and 4b and includes straight 
lines Lil, L2L, Lir, and L2R are 
calculated. 
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Directional vectors n and r2 of 
straight lines Li and L> of mark 3 
are calculated. 







Position data 



Unit directional vector rie of n 
and unit normal vector qe of 
object surface 2 are calculated. 
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Roll, pitch, and yaw of object 
surface 2 are calculated. 



i 

Posture data 



Fig.12 




Synchronization signal generator 

4a- 



■ AV> 



"~ Drive circuit 



Drive circuit 



T" 



11b 




3a 



12a 



Amplifier 



3b 




6b 



Memory 
control circuit 
~1 



r 



15 



J. 



14- 
13a 



A/D 



^I2b x13b 



Amplifier 



o 

(I) 

CO 

© 
u 
o 



-16. 



Display l/'7 



6a 




Fig.18 



[Fig. 19] 



Straight line position qij of mark images 3a and 
3b on one-dimensional optical sensors 6a and 
6b is calculated. 



Si 



Straight line positions An through A22 and D11 
and D22 of mark images 3a and 3b at light 
receiving surface 2 are calculated. 



S2 



Equations of straight lines Lil, I_2l, Lir, and L2R 
or mark images 3a and 3b at light receiving 
surface 2 are calculated. 
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Intersection of straight lines Lil 
and L2L and intersection Pr of 
straight lines Lir and L2R of mark 
images 3a and 3b are calculated. 



/Se 





r 


The position of i 
straight lines Li 
image 3 is 


ntersection P of 
and L2 of mark 
calculated. 



Position data 



Directional vec 
straight lines Li 
are cal< 


;tors n and ri of 
and L2 of mark 3 
culated. 






Unit directional vector ne of n 
and unit normal vector q e of 
object surface 2 are calculated. 






Roll, pitch, and yaw of object 
surface 2 are calculated. 



Posture data 



